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ABSTRACT 


This is the final report of a two-year study of digital 
control systems for space structural dampers, or more 
specifically, for proof -mass dampers or actuators. Previously, a 
proof-mass actuator had been developed, of which twelve had been 
delivered to NASA, and analog and digital control systems had been 
developed in prototype form. Under the first year of the present 
study, a Z80 controller was developed, slaved to a TRS80 microcom- 
puter. During the final year, which is covered in this report, a 
digital controller was developed using an SDK-51 System Design 
Kit, which incorporates an 8031 microcontroller. As part of this 
study, the necessary interfaces were installed in the wire-wrap 
area of the SDK-51 and a pulse-width modulator was developed to 
drive the coil of the actuator. Also, control equations were 
developed, using floating- point arithmetic. The design of the 
digital control system is emphasized in this report, and it is 
shown that, provided certain rules are followed, an adequate 
design can be achieved. It is recommended that the so-called 
w-plane design method be used, and that the time elapsed before 
output of the up-dated coil-force signal be kept as small as pos- 
sible. However, the cycle time for the controller should be 
watched carefully, because very small values for this time can 
lead to digital noise. 
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DEFINITIONS 


a q, a^ = Coefficients of polynomial 
ap,Ap = Structural acceleration 
b^ = Coefficient of polynomial 


c = Design damping (Ns/m) 

D(s) , etc. = Transfer function 

F = Coil force 2 

g = Acceleration of gravity (9.81 m/s ) 

G = Analog gain 

G* = Digital gain 

H(s) , etc. = Transfer function 

H (s) , etc. = Complex damping 


I n = Integer form of n 


k = Integer time-interval variable 
k^, etc. = Digital gain terms 


k = Maximum synthetic stiffness 
max 

k = Synthetic stiffness (N/m) 
s 

K = Analog gains used in calibration of system 
m = Integer time-count for data output 
M = Proof-mass (kg) 

n = Integer cycle-time count for calculation cycle 
R c (s) = Response amplitude ratio 


s = Laplace variable 
t = Time variable 
T = Calculation cycle time 

T Q = Basic time interval (256 microseconds) 

u,U = control state or output variable 
w = Transform variable 
x,X = Input variable 
z = Transform variable 

Z{> = z-transform equivalent of a Laplace transform 
<f>m = Phase margin 

y = Lag to lead frequency ratio 
£ = Accelerometer gain parameter 
v = w-Plane frequency 
(o = s-Plane frequency 

Subscripts : 

A = Accelerometer 

B = Component of damping equation 
c = Relating to damping 
C = Coil 


v 


to > 


D = Relative proof-mass motion 
L = LVDT 
P = Proximeter 

= Relating to stiffness 

= Component of synthetic stiffness equation 
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INTRODUCTION 

Discussion : This report covers the second year of a study of 
space structure damping under NASA Grant No. NAG-1-349, following 
Proposal No. MAE-NASA-2548-83 (1). Earlier, a general study of 
possible damper configurations had been reported under NASA Grant 
No. NAG-1-137-1 (2). Following that work, purchase order No. 
L46164B had been received from NASA for the design and construc- 
tion of twelve proof-mass actuators, also referred to as space 
structure dampers. A sectioned assembly drawing for this design 
is shown as Figure 1. During these last two years, Mr. Michael 
Mallette, a doctoral candidate, has worked on the development of 
control laws under a NASA student fellowship. His dissertation is 
imminent. Under the present two-year grant, earlier reports (3,4) 
have covered design of the proof-mass actuator, and development of 
analog and Z80 controllers. The work reported here covers 
development of an 8051 series controller exclusively. 

Equipment : The work on the 8051 series controllers was aided 
considerably by the donation of an SDK-51 System Design Kit from 
the INTEL Corporation. Also, two of the twelve NASA owned proof- 
mass actuators were obtained on loan, and were modified to take 
Bentley-Nevada Model 190 proximeter probes. This required two new 
cases, and tapered sleeves on the proof-masses , so that their 
position could be determined by proximeters . One of these 
actuators has been used by Mr. Mallette, this is shown in Figure 
2 with an accelerometer which is also on loan from NASA. The 
other was used in the present study. It has a Sunstrand Model QA- 
900 accelerometer, a Bentley-Nevada 3106-2800-190 amplifier, and a 
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Figure 1. PROOF-MASS ACTUATOR SECTION 
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Figure 2. PROOF-MASS ACTUATOR WITH PROXIMETER 
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home-made pulse-width modulator (PWM) attached. A control system 
was built in the wire-wrap area of the SDK-51 board, as described 
later . 

Work on the 8051 series : Work on the 8051 series controllers, 
which is literally an 8031, which has no internal program memory, 
was limited mainly to development of the system described above, 
and to the requisite SDK-51 programs, including two versions of 
the Pl-D control realization first discussed in Reference 4. 
Behavior of the system was largely checked by simple observation, 
relying on Mr. Mallette’s experience for further insight into its 
behavior. The following report covers a description of the 
controller hardware which was developed, and of the control 
program, together with computer predictions of the real damping 
vs. frequency, and of the relative amplitude of motion of the 
proof-mass within its case. The long general purpose SDK-51 
program which was used is listed in Appendix A. 

SDK-51 DEVELOPMENT BOARD 
Description 

An SDK-51 Development Board was obtained as a gift from the 
INTEL Corporation. Although it is designed for teaching the 8051 
language, a wire-wrap area is provided for user experiments. This 
area was used to configure a controller for the proof-mass damper. 
Components in this area include four analog input ports (two 
populated), an A/D converter, and pulse-width modulated (PWM) out- 
puts. An overall schematic of this system is shown in Figure 3, 



FIGURE 3. PROOF MASS ACTUATOR: DIGITAL LOGIC 
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12 MHz 





Page 6 


and logic diagrams are given in Appendix B. 

As presently configured, 12 pins on two ports of the 8031 are 
used. These are all eight pins of port 1, and pins 3.3,4, and 5 
of port 3. In addition, pin 3.0 has been programmed temporarily 
to indicated completion of digital calculations as an oscilloscope 
signal, but this could easily be discontinued. Pins 1.0, 1,2, and 
3 are connected to a transceiver, and can be used for output, 
otherwise, port 1 is used to read the A/D. Pin assignments are as 
follows : 


Port 

, 1 

(Input) 

Read A/D 

Pin 

1.0 

(Output) 

Input, channel selection 

Pin 

1.1 

II 

ii ii ii 

Pin 

1.2 

It 

Trigger A/D 

Pin 

1.3 

11 

Enable A/D 

Pin 

o 

CO 

(Output) 

Temporary oscilloscope signal. 

Pin 

CO 

CO 

II 

Sets transceiver to output when high. 

Pin 

CO 

It 

Sets L.H. end of coil to high voltage 

Pin 

CO 

II 

Sets R.H. end of coil to high voltage 


Four analog inputs were originally designed, but two will not 
be populated (LVDT and signal generator) until requirements for a 
slaved 8031 have been determined. The two which have been 
populated are #0, proximeter, and #1, accelerometer. The four 
inputs are selected by the outputs of Pins 1.0, and 1, through 
half of a 74LS139 decoder, and an LF13332 analog switch, with a 
TL087 high speed operational amplifier to improve output 
impedance. The selected signal is converted directly to 2’s com- 
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plement eight-bit form using a DAC0800 D/A and a DM2502 successive 
approximation register, with a LM361 high speed comparator to com- 
pare the two signals. Timing comes from the 12MHz crystal on the 
SDK-51 board, divided by powers of two in a 74LS163, as selected 
by jumpers. Signals are synchronized by a dual D-f lip-flop, in a 
one-and-one-only configuration. A 75451 driver is used for the 
PWM output; the actual PWM function is carried out on a separate 
board attached to the proof -mass damper. This board consists of 
two pairs of Darlington transistors (NTE261 and NTE262) , one pair 
is attached to each end of the coil, their bases are driven by 
2N3904 transistors, which are themselves driven by 4N28 opto- 
electrical transistors from the PWM signals. With this 
arrangement, about +1 to -1 Amperes can be produced in the 8.5 Ohm 
coil. However, an important feature of this arrangement is that 
there is no coil current when both F'WM signals are equal. Thus 
the coil does not heat up when the proof-mass damper is quiescent. 

Comparison of 8051 with Z80 : 

The work reported here, in conjunction with the work reported for 
the previous year in Reference 4, affords an opportunity to com- 
pare the 8051 with the Z80, in the following ways: 

Advantages of 8051 Series : 

Multiplication : Only available on the 8051 series. 

Division : Only available on the 8051 series, but of dubious 
value because it only produces the integer part of the 
quotient . 
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On-Board Timer : There are two onboard timers on the 8051 
series, both with interrupts, whereas the same functions have 
to be provided by hardware with the Z80 (the 8052 series has 
an additional timer) . 

Interrupt Priority : There are two levels of interrupt 
priority, with a total of five interrupts (two timer, two 
general, and one serial). Again, this arrangement must be 
provided by hardware for the Z80 . 

Internal RAM : Internal RAM is provided on the 8051 series, 
with one page of byte addresses, plus another page of bit 
addresses covering part of the same field. One half page is 
devoted in each case to special function registers. This 
provides computing power unique to the 8051 series. 

Internal UART : An internal UART on the 8051 series makes 
master-slave arrangements relatively simple. A third timer 
can be used to provide the needed Baud rate, or very high 
speed serial data exchange can be obtained using the clock- 
timer. In the master-slave arrangement, several slaves can 
be addressed individually. 

Advantages of Z80 : 

16-Bit Arithmetic : Many operations can be carried out with 
16 bits, compared to only 8 bits on the 8051 series. 

BUSREQ : This feature of the Z80 permits a single slave 
arrangement in which the memory space of the slave is 
relatively easy to address. This proved to be a great 
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advantage in the development of the Z80 system. 

Vectored Interrupts : The Z80 can receive address vectors for 
interrupts, which simplifies the selection of different 
programs when running as a slave . 

IN /OUT : The separate mapping of in/out memory space was an 
advantage, because these instructions could be decoded, and 
could be used to trigger operations such as read A/D. The 
same functions are obtained on the 8051 series by SETB and 
CLR instructions to the port pins. 

The Z80 is Used in Small Computers : The fact that the Z80 is 
a well- known and popular computer chip was to its advantage 
in last year’s work because it was relatively simple to use 
the Radio Shack Model 1 computer as a development system. A 
comparable system for the 8051 series, although considerably 
better, costs about ten times as much. 

DERIVATION OF DIGITAL CONTROL EQUATIONS 

Floating Point Subroutines 

Since the INTEL 8051 series controller can only execute eight 
bit arithmetic, unlike the Z80 which can handle many sixteen bit 
operations, an early decision was made to use a sixteen (16) bit 
floating point format, with a signed seven bit mantissa and 
exponent, as follows: 

Bit # 15 14 13 12 11 10 9 8 7 6543210 
sign of mantissa sign of exponent 
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mantissa exponent 

Thus +1 becomes .40X01, and -1 becomes .80X00, where X stands 
for exponent, and the decimal point means that the mantissa is 
fractional. We cannot use E for the exponent, as with decimals, 
because it is a hexadecimal digit. 

The following subroutines are available: 

ADD NEGATE 

SUBTRACT MOVE IN MEMORY 

MULTIPLY FIXED TO FLOATING- FROM MEM. 

STORE ABOVE RESULTS FIXED TO FLOATING- FROM ACCUM. 

IN MEMORY FLOATING TO FIXED 


These subroutines are identified in the listing supplied in 
the Appendix. Results of all operations except FLOATING TO FIXED 
are normalized by shifting ones into positive numbers and zeros 
into negative numbers, thus: 

.00X00 becomes .7FXF9 
. 3FX00 " . 7FXFF 
. FFX00 " . 80XF9 
. C0X00 " . 80XFF 

Sometimes, the application of an operation and its inverse, 
such as ADD and SUBTRACT, or NEGATE NEGATE, results in a change in 
the last bit. Also, if exponent overflow occurs, it is replaced 
by X7F or X80, as appropriate, but the mantissa is meaningless. 
Further, the difference of two equal numbers leaves a zero 
mantissa, which is then normalized as a positive number. Thus the 
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final result, has a mantissa of .7F, while the exponent is reduced 
by 7. 


The program in Appendix A includes a floating point cal- 
culator simulation program, similar to the reverse Polish system 
on the Hewlett-Packard calculators. The program includes all of 
the subroutines listed, with the exception of FIXED TO FLOATING, 
which is covered by the NORMALIZE operation. In addition, numbers 
can be entered into the display on the SDK 51 board, and the com- 
mand ENTER can then enter them into a three tier stack, while READ 
can bring them back into the display. Operations on two numbers 
involve the SDK 51 display and the first number on the stack, the 
result is displayed, and the stack is moved down by one. The cal- 
culator program was written to permit development of the floating 
point subroutines, and to make it easier to calculate parameters 
to be used in experimental programs. It includes provisions for 
inserting floating-point parameters into data memory for use in 
the control programs . 

Often it is necessary to find the floating point equivalent 
of a decimal number for insertion into the controller program. 
The following procedure was found to be useful: 

E 

(a) Express in form M x 2 

(b) Convert to form .MH x 2 

(c) Write in form .MHX(EH+7) for entry onto board. 

(d) Write in form MH, (EH+7) for entering into memory. 


Note: M,E are decimal integers, with M between 63 and 127, 
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while MH and EH are 
places . 

Example: Convert 0.0287 

(a) .0287 = 117 x 2~ 12 

(b) = . 75H x 2~ 12+7 

(c) = . 75XFB 

(d) = 75H , FBH 


hexadecimal equivalents 


= . 75H x 2 


FBH 


to 2 


To find the decimal equivalent , this process is reversed: 

(a) Express in form MH x 2 FB 7 

(b) Convert to form M x 2 F 7 

(c) Evaluate 

Example: Convert .75XFB 


(a) .75XFB 

= 75H x 2 FBH - 7 

= 75H x 2 F4H 

(b) 

= (7 x 16 + 5) 

x 2 -12 = 117 x 2 -12 

(c) 

= 117/4096 = 0 

.0286 


Digital Program by Rectangular Rule 

The program shown in Appendix A is based on the rectangular 
rule of integration, but such refinements as zero-order-hold and 
computational delay have been omitted. The program corresponds 
very closely to the Pl-D program of Reference 1, except that the 
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16-bit arithmetic of the Z80 has been replaced by the floating 
point arithmetic described in the preceding paragraph, and the 
divide by powers-of-two operations have been replaced by full mul- 
tiplications . 

The system to be investigated is shown in block diagram form 
in Figure 4. Some changes in notation have been made relative to 
Reference 4, mainly the replacement of number subscripts to avoid 
confusion with state-space notation, and a redefinition of H^. 

From Figure 4: 

F(s) = H a (s)A f (s) - H p (s)X D (s) 
while, from the dynamics of the proof mass 
F(s) = MA F (s) + Ms 2 X d (s) 

The signal generator input, Xg, has not been included in 
these equations. We can now develop two functions which are of 
considerable importance in the evaluation of damper performance: 

H c (s) = sF(s)/A f (s) 

= s{(H a (s) + Hp (s) / s 2 ) / (1 + H p (s)/Ms 2 )} 

R c (s) = s 2 X d (s)/A f (s) 

= - (1 - H a (s)/M)/( 1 + H p (s)/Ms 2 ) 

where H^, is the complex damping, whose real part must be positive 
at any frequency at which energy is to be absorbed, and R^, is the 
ratio of the proof-mass amplitude to that of the structure. For 

example, if its norm is 2, then the proof mass will just hit the 
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stops of a one inch stroke damper when the structural double- 
amplitude reaches a half inch. 

It has been found that satisfactory values for Re{H^} and 
Norm{H^-,} can be obtained if the following rules are followed: 

(1) There is a positive input to the A/D (this may mean a 
negative voltage, because most A/D’s invert) when there is an 
acceleration directed from the structure to the damper, i.e., a 
positive acceleration. 

(2) There is a positive input to the A/D when the proof-mass 
is against the structure, i.e., a negative displacement. 

(3) A +/- lg accelerometer range exactly covers the full 
input range to the A/D. (referred to as +/- 1 here, rather than 
to a range of voltages) . 

(4) The full range of proof-mass travel exactly covers the 
full input range to the A/D. 

(5) The force exerted on the proof mass, when the 

accelerometer is attached, exactly balances its weight component. 

(6) The synthetic spring stiffness, k , is a fraction of the 

s 

maximum available value, k , chosen to give suitable centering 

m£LX 

behavior . 

(7) At high frequency, should approach the real value, c, 
of the required design damping. 

(8) At high frequency, Hp should approach zero. 

2 

(9) The open loop gain, Hp/Ms , of the synthetic spring cir- 
cuit should have an adequate phase margin. 

Rules 1 and 2 ensure the correct polarity, and permit a sim- 
ple evaluation of the damper using the DEMO modes described in the 
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Appendix. When this polarity is correct, the damper exhibits sim- 
ple spring behavior or a tendency to remain centered when the dam- 
per assembly is tilted, according to which DEMO program is selec- 
ted . 


Rules 3 and 4 permit calibration of the system by one of the 
following methods: 

(a) Direct monitoring of the A/D inputs with a voltmeter. 

(b) Use of the DISPLAY subroutine described in the Appendix 
which displays the input in 2’s complement hexadecimal form on the 
SDK-51 board. 

(c) Use of the appropriate DEMO program together with 
monitoring of the output to the coil. 

Applying these rules, we have: 

K a = 1/lg = 1/9.8 = 0.1020 s 2 /m 

Kp = (40 ins/m)/ (1/2 inch amplitude) = 80 m * 

Rules 3 and 7 are satisfied if has the form: 

H a (s) = 2M$/(l+s/« A ) 

with 


£ = c/2Mo» a 

while rule 5 is satisfied when £=1/2. 

Rules 4,6 and 8 are satisfied if Hp(s) has the form: 


H p (s) = k g (1 + s/wy) / (1+s/ojp) 
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so that the open-loop transfer function is: 

H p (s) /Ms 2 = O n 2 /s 2 ) (l + s/aj) v )/(l+s/co)p) 

where : 

“N 2 = V M 

and : 


< k = K D K r 
max P C 


From several measurements on the present damper design, when 
the current is adjusted to range from -1 to +1 Amps. over the 
full range of digital input: 


K c = 1.92 N 


thus : 


k = KpKp 

max P C 


= (80 m 1 )(1.93 N) = 155 N/m 


Rule 9 is satisfied if suitable values are picked for the two 
break frequencies in Hp(s) . Using the Bode plot of Figure 5, and 
designing for a phase margin of <f>^: 

y = cop/wy 

= 1/ (tan (45 - <f>^/ 2) ) 2 
where, from the geometry of the figure 5: 

/ l / 4 

“V = w N /v 



ln 9 amplitude 


Page 18 


FIGURE 5. BODE PLOTS OF 
SYNTHETIC SPRING: ANALOG 
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1/4 

"c = “ N y 

3/4 

W P = 

Difference Equations for Pl-D : From Figure 4, the difference 

equations must provide the two filters: 

H a (s)/K a K c = (2^M/K a K c )/(1+s/o> a ) 

= G a / (s+« a ) 

Hp(s)/K p K c = ( k s /k max ) (l+s/o) v )/(l+s/&> p ) 

= (sGy+Gp/ (s+o>p) 

The digital equations for the realizations of these filters 
are derived using the rectangular rule as follows: 

x p (k) = x p (k) or x L (k) 

u p (k) = (1-WpT) Up (k-1) -GpTxp(k) 

- Gy{x p (k) -x p (k-1) > 

u A (k) = (l-m A T)u A (k-l) + G A Tx A (k) 

u (k) = Up (k) + u A (k) + x g (k) 

It may be noted that the second and third equations could be 
written as the two equations: 

Uy (k) = Uy(k-l) — WpTup(k— 1) — GpTxp(k) 

Up (k) = Uy(k) - GyXp(k) 

where Uy 


is 


essentially a state variable. 


Note that these 
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equations include the input Xg from the signal generator, and the 
alternative position signal from the LVDT . 

Implementation of Program : Appendix A describes a program with 

two modes of input. They are: 

Program P: This program has default parameters, as shown below in 

parenthesis. New parameters can be entered, and the program can 
be restarted as Program Q. Values for these parameters are 

determined as follows: 


I = Integer value of n used to count cycles. 

(= .10X00 = 16) 

T = Time interval , musecs . 

= 256n 

(= .43XF9 = 4096 musecs) 

( d ^ = Accelerometer break frequency, rads/sec. 

= c/2£M 

(= .48X06 = 36 rads/sec.) 

Wp = Proximeter (or LVDT) break frequency, rads/sec. 

3/4 

= y "N 

(= . 5EX07 = 94.4 rads/sec) 

= Accelerometer gain. 


= c/K a K c 
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(= .66X06 = 50.8) 

Gp = Proximeter gain. 

- kg^p/^max 
= v 3/4 m«, n 3 /k p k c 
(= . 5EX05 = 23.6) 

Gy = Proximeter feedforward gain. 

= G p/ W y 

= v 1 ^ 4 Gp/&> N 
(= .40X03 = 4.0) 

The above equations assume that the design damping, c Ns/m, 
and the required synthetic spring frequency, rads/sec., are 
known. Also, n must be chosen so that the program has time to 
complete a cycle of calculations. As for the default parameters, 
values for K^, Kp, and are assumed as discussed earlier, the 
proof mass M is 0.278 kg., { is 1/2, and y is 16, corresponding to 
a phase margin ,cf >^ , of 62 degrees. Default values for n, c, and 
are the same as for Program T discussed below. 

Program T: In this program, default values are included for the 

following parameters, and the remainder are calculated from them. 
They can be entered, and the program can be restarted as Program 
U: 


n 


= Integer value for n in floating-point format. 
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(= .40X05 =16) 

c = Design damping, Ns/m. 

(= .50X04 = 10 Ns/m) 

= Synthetic spring natural frequency, rads/sec. 

= SQRT{k /M} , where k =design stiffness, N/m. 
s s 

(= .5EX04 = 11.8 rads/sec, i.e., k =38.7 N/m) 

Plots of Real Damping and Response Amplitude : Plots of the real 

damping, Re{H^,}, and the amplitude of the response ratio, 
Norm{R^} , are supplied as Figures 6 to 15 for five values of the 
design damping, c, three values of the design stiffness, k , and 
three values of £ . Note that the real damping goes negative at 
low frequencies when £ > 1/2. Otherwise, the damping is positive 
over the range of frequencies shown, and is asymptotic to the 
design damping, c. Although the design stiffness, k g , was varied 
over a 16:1 range, it had relatively little effect on the damping 
curves. Previous investigations, using much lower values for the 
phase margin, have shown resonance peaks in both curves. 
Unfortunately, due to the choice of program for the Z80, adequate 
phase margins could not be used, however, the problem of resonance 
peaks has been solved since the introduction of floating-point 
arithmetic . 


Timing : The P and T programs described in the Appendix use the #0 

and #1 timer interrupt modes available on the 8051 series. The #0 
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Proof Mass 
Zeta (C) 
Gamma (Y ) 


(m) 


= .278 
= .5 
= 16 


kg 




Figure 6. PEAL DAMPING FOR PROOF-MASS 

ACTUATOR WITH ANALOG CONTROLLER: 
LOW SYNTHETIC STIFFNESS 


NORM OF RESP. RATIO K=9.7 

.20 0.40 0.60 0-80 1 - 00 1.20 1.40 1-60 1.80 
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Figure 7. NORM OF RESPONSE RATIO 
FOR PROOF-MASS ACTUATOR 
WITH ANALOG CONTROLLER: 
LOW SYNTHETIC STIFFNESS 


Proof Mass (m) = .278 kg 

Zeta U) = .5 

Gamma (y) =16 

Synthetic Stiffness (k) = 9.7 N/m 

_ . ~ k max/ 1 6 

Design Damping (c) = 5/ 10, 20, 40, 80 N.s/m 


0=5 N.s/m j 



00 - 


Figure 8 . REAL DAMPING FOR PROOF-MASS 

ACTUATOR WITH ANALOG CONTROLLER : 
LOW ACCELEROMETER GAIN 


o 

o 

CO_ 


O 

O 

'T _ 


Proof Mass (m) = .278 kg 
Zeta (?) = .25 

Gamma (Y) =16 

Synthetic Stiffness (k) = 38.7 N/m 

“ ^max/4 

Design Damping (c) = 5, 10, 20, 40, 80 N.s/m 
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o 

oo 


Figure 9. NORM OF RESPONSE RATIO FOR 

PROOF-MASS ACTUATOR WITH ANALOG 
CONTROLLER: LOW ACCELEROMETER GAIN 


O 

co 


O 


LO 

C\J 


Proof Mass (m) = .278 KG kg 

Zeta (?) = .25 

Gamma (y) = 16 

Synthetic Stiffness (k) = 38.7 N/m 

~ ^max/4 

Design Damping (c) = 5, 10, 20, 40, 80 N.s/m 


jL° 

<C<M 


c = 5 N.s/m 



20.00 


FREQ. RAD/SEC. 

40.00 60.00 80-00 100-00 


120.00 
_] 


O 


REAL HC NS/M RUN - K=38-7 

.00 -4.00 . O.ftO 4.00 8-00 12.00 16.00 20.00 24.00 28.00 
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Figure 10. REAL DAMPING FOR PROOF -MASS 

ACTUATOR WITH ANALOG CONTROLLER: 
DEFAULT VALUES 


Proof Mass (m) = .278 kg 

Zeta (^) = .5 

Gamma (Y) = 16 

Synthetic Stiffness (k) = 38.7 N/m 



ooJ 

I 


NORM OF RESP. RATIO K=38.7 

.20 0.40 0.60 0.80 I . 00 1-20 1.40 1.60 1.80 
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Figure 11. NORM OF RESPONSE RATIO FOR PROOF-MASS 
ACTUATOR WITH ANALOG CONTROLLER: 
DAFAULT VALUES 


Proof Mass (m) = .278 kg j 

Zeta (C) = .5 ! 

Gamma (Y) = 16 

Synthetic Stiffness (k) = 38.7 N/m 

k max/ 4 

Design Damping (c) = 5, 10, 20, 40, 80 N.s/m 1 


c = 5 N.s/m 


FREQ. RAD/SEC- 

20.00 40-00 60.00 80.00 100-00 120.00 
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Figure 13. NORM OF RESPONSE RATIO FOR PROOF-MASS 
ACTUATOR, WITH ANALOG CONTROLLER: 

HIGH ACCELEROMETER GAIN 



o 
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Figure 15. NORM OF RESPONSE RATIO FOR PROOF -MASS 
ACTUATOR WITH ANALOG CONTROLLER: 

o HIGH SYNTHETIC STIFFNESS 

oo 
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interrupt is encountered every 256 musecs, and is used to reset 
the pulse-width-modulator (PWM) , while the #1 interrupt is used to 
set the pulse width of the PWM. The counter n is used to set the 
value for T, which is equal to 256n musecs. Typically, n has been 
16, resulting in a value for T of 4096 musecs. Lower values, such 
as 3072 musecs, have been used, but, according to Reference 5, an 
excessively small value for T can cause problems with round-off 
noise, even if the digital calculations are completed in time. 
Both the P and T programs update their output at the end of their 
cycle, so that there is a full-cycle time-delay of T. 


Digital Program by w-Plane Analysis 

The control equations described in the preceding paragraphs, 
and contained in the program described in Appendix A, do not allow 
for a zero-order-hold, or for the time delay T which is inherent 
in the method of calculation. Typically, an analog plant driven 
by a digital filter can be represented by Figure 16a, if there is 
no time delay , and by Figure 16b if there is a time delay, fol- 
lowing methods described in the literature, such as for example, 
in References 5 or 6 . The zero-order hold has a z-transform equal 
to (z-l)/z, thus the open loop transfer functions are: 

for no delay: 

U(z)/X(z) = H(z)((z-l)/z)Z{G(s)/s> 
and for a delay of T: 

U(z)/X(z) = H(z) ((z-l)/z 2 )Z{G(s)/s> 
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FIGURE 16. DIGITAL FILTER WITH ANALOG PLANT: EFFECT OF DELAY 
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where Z represents the z-transform equivalent of a Laplace trans- 
form. A block diagram of the damper, corresponding to Figure 4, 
but incorporating the concepts shown in Figure- 16, is shown in 
Figure 17. The input is represented as an acceleration a^, so 
that the z-transform derived below represents F(z)/Ap(z), which 
can be readily converted to the form H^-, . First, two equations are 
derived from Figure 16: 

F(z) = {H A ( Z )Ap(z) - H p O)X D (z)}/z 
Xjj(z) = <F(z)/M-A f (z)>((z-1)/z)Z{1/s S > 
so that the overall transfer-function can be written as: 

F(z)/Ap(z) = {D a (z) + MD p (z)>/{l + D p (z) } 

Note that : 

Z{l/s 3 } = T 2 z(z+1)/2(z-1) 3 

then : 

D a (z) = H A ( z ) / z 

D p (z) = H p (z)((z-l)/z 2 )Z{l/Ms 3 > 

= H p (z) (T 2 /2M) (z+1) /z (z-1) 2 

The w-transform maps the z-plane into a space which more 
nearly resembles the s-plane. In fact, as s moves along the 
imaginary axis from zero to the Nyquist frequency, as represented 
by s = jo>, w moves along the real axis from zero to infinity, as 
represented by w= j v . The substitution for z is: 
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z = {1 + wT/2}/{1 - wT/2} 
while v is given by: 

v = (2/T) tan{wT/2}- 
the inverse being given by: 

G> = (2/T)arctan-{>T/2} 

so that the D (w) transfer functions become: 
d a (w) = H a (w){1 - wT/ 2>/{1 + wT/2> 

D p (w) = H p (w) { 1 - wT/2} 2 /Mw 2 {1 + wT/2> 

Design in the w-Plane : The rules for designing in the w-plane are 

almost identical to those for designing in the s-plane. The 
familiar Bode plots can be made, the only difficulty being that 
the w-transfer functions are often not of minimum phase form. 
This means that the phase cannot be inferred from the Bode plot 
alone, but this is not a problem of any significance. The Bode 
plots for D^(w) and Dp(w) are shown in Figures 18 and 19. In the 
following discussion, T=4096 musecs, so that the Nyquist frequency 
is 7t/T= 767 rads/sec in the s plane. Proceeding with the design 

in the w-plane, using almost identical methods to those used in 
the s-plane, but taking £=1/2, we find that: 

H a (w) = M/{1+wA a > 

Hp (w) = k s {l+w/*'y}/{l+w/*'p} 

Using the previous default values of n (=16) , c (=10 Ns/m) , 


ln« amplitude 
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FIGURE 18. BODE PLOT OF SYNTHETIC 
DAMPER: DIGITAL 



ln^ amplitude 
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FIGURE 19. BODE PLOTS OF SYNTHETIC 
SPRING: DIGITAL 



C\i |H 
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and k g (=38.7 N/m) , and taking y=16, we find values for v A , v-p, 
and Vy which are numerically equal to the corresponding co values 
found for the analog design case. Thus the actual (o values have 
decreased according to the transformation law given above. 

The apparent -1 break at i>=2/T=488.3 rads/sec in the Bode 
plot of Dp(w) is misleading, because it is a multiple phase break 
and introduces additional phase lags of 90 degrees in the case of 
and 135 degrees in the case of Dp. For D A to have the high 
frequency performance characteristic of a damper, it should lag 90 
degrees. However, calculations show that the lag is 180 degrees, 
so that real damping is zero, at v= 525 rads/sec, corresponding to 
a true frequency of 401 rads/sec. Again, although the value for 
the gain at the design crossing frequency v ^ (= 23.6 rads/sec.) 
of the open-loop transfer function Dp is calculated to be 0.9996, 
the phase margin is found to be 8.4 degrees less than the design 
value of 62 degrees, because of the triple phase break at T/2 

Derivation of the Difference Equations : To transform back to the 

z-plane, we apply the transformation: 

w = (2/T) (z-l)/(z + l) 

From Figure 16, the difference equations must provide two 
filters which, on transformation to the z-plane, become: 

H a (z)/K a K c = G* a (z+ 1)/ (z-k A ) 

Hp(z)/K p K c = G*p(z-k v )/(z-k p ) 

Values for the new terms are as follows, with numerical 
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default values in parenthesis: 

G* a = (cT/2K a K g )/(1 + ^ a T/2) 

(= 0.194/2) 

k A = (1 -v a T/2)/(1+v a T/2) 

(= 0.863) 

G * P = ( k,/ p/ k max I, v) (i+*' v T / 2 )/( 1 +*' p T/ 2 ) 

(= 3.39) 

k v = (l -,/ v T/2)/ (l + VyT/2) 

(= 0.976) 

k P = (l-VpT/2)/ (l+v p T/2) 

(= 0.676) 

The difference equations derived from the above are: 
Up(lc) = kpUp(k-l) - G*p(l-ky){xp(k)+x p (k-l)>/2 

- G* p (1+ky) {x p (k) -x p (k-1) >/2 

u A ( k ) = k A u A ( k-1 ) + GSf ' A { x A ( k ) +x A ( k - 1 )> 

These can be compared with the equations obtained by the 
tangular rule from the analog design; 

u p (k) = (l-WpT)u p (k-l) - GpTxp(k) 

-Gy{x p (k)-x p (k-l)> 


rec- 
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u A (k) = (l-o> A T)u A (k-l) + G A Tx A (k) 

It will be noted that the w-plane design method directly 
implies use of the trapezoidal rule. It is easier to compare the 
two approaches if the default values are substituted for the 
coefficients. For the w-plane design, we get: 

u p (k) = 0 . 676u p (k-1) - 0 . 0814{x p (k) +x p (k-1) }/2 

- 3 . 35{x p (k) -x p (k-1) > 

u A (k) = 0.863u A (k-l) +0 . 194{x A (k) +x A (k-l) }/2 

which can be compared with the results of the rectangular rule 
design : 


Up(k) = 0.613up(k-l) - 0.0967xp(k) - 4 . 0{xp (k) -Xp (k-1) } 

u A (k) = 0.853u A (k-l) + 0.208x A (k) 

The worst difference between the coefficients used in the two 
sets of equations is about 20 percent, so that, evidently, there 
is no serious loss of performance with the rectangular rule. The 
difference equations for the w-plane design can be put into more 
useable form, and the damping can be calculated readily from its 
w-transform. However, we shall look into another point first. 

System with Minimum Delay 

Numerical Accuracy : Consider first, that only the accelerometer 

2 

circuit is active. Then a +1 input, representing 9.8 m/s if the 
channel is calibrated, should result in a force on the proof-mass 
of Mg = 2.72 N, or an output from the computer of Mg/K c = 1.42, 
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which is out of the range of the system. As a check on numerical 
accuracy, let u^(k-l) equal 1.42, and let x^(k) equal 1.0, then: 

u A (k) = (0.863) (1 .42) + (0.194) 

= 1.42 

= u A (k-i) 

However, the output is quantized to only 256 values, so that 
the maximum input of +1 is equivalent to (0.194) (256) = 49 
quantized values. In other words, there are only 49 possible 
values for the coil force in the static case, and one third of 
them are out of range. Looking at the synthetic spring from the 
same approach, an input of -1, representing the proof mass against 
the structure, should result in an output of 0.25, representing 
one quarter of k . Taking u v (k-l) equal to 0.25, and x D (k) 
equal to -1, we get: 

Up (k) = (0.676) (0.25) - (.0814) (-1) 

= 0.25 

= Up(k-l) 

In this case, however, the input is equivalent to 

(0 . 0814) (256) = 20 values, so that the restoring force is limited 

to 20 quantized values. It is somewhat surprising that the 

synthetic spring appears to be smooth to the touch, however, it 

might prove impossible to obtain a very small spring value, equal 

to a few percent of k . This quantization effect would be 

max 

reduced if T were increased, but the phase margin might also be 
reduced at the same time . 
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Minimum Delay : Figure 20 shows an analog plant driven by a 
digital filter in which the time delay is kept to a minimum by 
timing the output to occur immediately after the calculations are 
completed. The basic period Tq is assumed to be 256 musecs, but 
calculations are repeated every T (=nTg) musecs, while output 
occurs at hiTq, with m<n . We now have the open-loop transfer func- 
tion : 

U(z n ) /X(z n ) = H(z n )((z n -l)/z n+m )Z n {G(s)/s> 

The delay and zero-order hold blocks of Figure 17 can be 
modified accordingly, so that the overall transfer function 
becomes : 

F(z n )/A F (z n ) = {D A (z n ) + MD p (z n )>/{l + D p (z n )> 

where : 

D A (z n ) = H A /z m 

D p (z 11 ) = H p (z n )((z n -l)/z n+m )Z n {l/Ms 3 > 

= H p (z n ) (T 2 /2M) (z n +l)/z m (z n -l) 2 
The w-transform is now: 

z n = (l+wT/2) / (l-wT/2) 
with its inverse: 

w = (2/T) (z n -l)/(z n +l) 


also : 


OJ 


= (2/T) arc tan (^T/2) 


FILTER I I DELAY 1 I z.o.h I I PLANT 
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FIGURE 20. DIGITAL FILTER WITH ANALOG PLANT: IMMEDIATE OUTPUT 
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and : 


v = (2/T) tan (a>T/2) 

The D(w) transfer functions now become: 
d a (w) = H A (w)({l-wT/2>/{l + wT/2» m/n 
D p (w) = H p (w){l-wT/2> (1+m/n) /Mw 2 {l+wT/2> m/n 

Thus, apart from a change in output timing, and possible 
redesign for improved phase margin, the difference equations are 
essentially unchanged when the output is speeded up. However, 
there should be an improvement in the real damping as m/n is 
decreased, which would partially offset the effect of increasing n 
to obtain longer cycle times. 

Difference Equations for Minimum Delay Case : Assuming that the 

H a (w) and Hp(w) filters are essentially the same as before, we 
find that on applying the inverse w-transform we have H A (z n ) and 
Hp(z n ) . However, in obtaining the difference equations from 
these, we obtain expressions for Uy (nkT^) =Uy (kT) , etc., so that 
the final equations are the same as before. The form in which the 
equations were left is not the most convenient, but note that the 
first order transfer function: 

u(z)/x(z) = a Q (l + z 1 a 1 )/(l + z 1 b 1 ) 

can either be written as: 

u(k) = -b^Ck-l) + a Q x(k) +aQa 1 x(k-l) 


or as the pair of equations: 
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u x (k) = -b 1 u 1 (k-l) - (a Q /b 1 )x(k) 

u (k) = (a 1 -b 1 )u 1 (k) + (a () a 1 /b 1 )x(k) 

where the additional variable, u^ is essentially a state variable. 
Using this representation, the complete set of equations can be 
written as: 

x p (k) = x p (k) or x L (k) 

u y(k) = kpUy(k— 1) — (G p/kp)xp(k) 

u p(k) = (kp— ky)uy(k) — (G pky/kp)xp(k) 

u B (k) = k A u B (k-l) + (G :+ A /k A )x A (k) 
u A (k) = (l+k A ) u B (k) - (G* A /k A )x A (k) 
u(k) = Up (k) + u A (k) + x g (k) 
where Uy, Ug are the corresponding state variables. 

Plots of Real Damping : The real damping can be calculated as: 

H c = REAL{ jwF (z) /A p (z) > 

This is shown in Figures 21 to 24 for four cases each. One 
represents the analog approximation obtained by taking T=0 and is 
identical to the results shown in Figure 9 for the same 
parameters, while the remaining three cases are for T=4096, 8192, 
and 16,384 microseconds. The other parameters which are varied 
are the output time delay, which is 0 and 4096 microseconds, 
(m=0,16), and the design damping, which is 10 and 80 Ns/m. The 
cases where T and the time delay are both 4096 microseconds 


REAL HC NS/M RUN - M=0 

O.gO 2.00 4.00 6.00 8.00 10.00 12.00 14.00 16.00 18.00 




REAL HC NS/M RUN - M=16 

2.00 4-00 6.00 8.00 10.00 12.00 14.00 16.00 18.00 
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FIGURE 22 


Real Damping for Proof-Mass Actuator with Digital Controller 

Proof Mass (m) = .278kg 
Synthetic Stiffness = 38.7 N/m 
Design Damping (c) = 10 Ns/m 
Computation Delay (mT 0 ) = 4096ys 



REAL HC NS/M RUN - M=0.C=80 

8-00 16.00 24-00 32.00 40.00 48.00 56.00 64.00 7 2.00 
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FIGURE 23 

Real Damping for Proof-Mass Actuator with Digital Controller 

Proof Mass (m) = .278kg 
Synthetic Stiffness (k) = 38.7 N/m 
Design Damping (c) =80 Ns/m 
Computation Delay (mT 0 ) = 0 


co 



560 . 

_L 


REAL HC NS/M RUN - M=16,C=80 

8.00 16.00 24.00 32.00 40.00 48.00 56.00 64.00 72.00 
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corresponds to the P- and T-programs listed in Appendix A. 

As might be expected, better agreement with the analog 
approximation is shown when the time delay is 0. Otherwise, 
agreement is best when T is a minimum. However, at low 
frequencies, the higher values for T show increased damping, 
presumably because of greater phase lags. It must be emphasized 
that two of the timing cases, where the time delay is zero or 
equal to T, have accurate solutions. The remaining cases 
introduce additional approximations of uncertain validity. 


SUMMARY 


Controller Design : The third in a series of controllers for the 

UVA Proof-Mass Actuator has been designed, built in prototype 
form, and demonstrated. The present design uses an INTEL 8031 
microcontroller mounted in an SDK-51 System Design Kit. 
Previously, an analog controller had been breadboarded , and a Z80 
controller had been developed as a slave to a TRS80 computer. 
References 7 and 8 are essential for working with the SDK-51, and 
Reference 9 is of great help. 

Digital Control Equations : A procedure for developing digital 

control equations has been developed, which meets specific 
requirements : 

* A given design damping value . 

* Insensitivity to steady acceleration, including gravity. 

* A given design centering stiffness. 
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* A specified phase margin. 

Equations based on rectangular integration have been 
demonstrated. Improved equations, based on w-transform theory, 
have been developed, which show small changes from the 
demonstrated values. Finally, real damping vs. frequency has 
been calculated for both sets of equations, and results of these 
calculations have been presented in this report. 

Floating-Point Calculations : The demonstrated equations used 

floating-point subroutines which were developed for the 8051 
series microcontrollers. 

Pulse Width Modulation : A pulse-width modulator (PWM) was 

developed for the proof-mass actuator. This draws no current and 
therefore develops no heat when the actuator is in a quiescent 
state . 

Word Length : It is recognized that four factors determine the 

accuracy of the control program, they are: 

* Possible loss of accuracy due to limited word length in 
input and output. 

* Possible loss of significance due to overflow or underflow 
during internal calculations. 

* Digital noise due to inadequate word length. 

* Long computational time due to arithmetic complexity. 

Experience with the Z80 and the current 8051 series control 
programs gave no indications of problems due to input or output 
word length. For example, when programmed as a pure spring, the 
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proof -mass appears to behave smoothly, without any apparent 
’stair-step’ feel when operated manually. However, with the 16- 
bit Z80 system, there were definite indications of internal number 
overflow. Possibly, these could have been corrected by shifting 
to the middle 8 bits for input and output. However, the 8051 
series is not well adapted to 16-bit arithmetic, and this is why 
the floating-point approach was tried. Several other schemes 
could have been used, overall, one might consider any of the fol- 
lowing : 

* Signed 7-bit arithmetic (8-bit total) . 

* Signed 15-bit arithmetic (16-bit total) . 

* Signed 15-bit arithmetic with shift (16-bit total) . 

* Signed 7-bit mantissa and exponent (16-bit total) . 

* Signed 11-bit mantissa and signed 3-bit exponent (16-bit 

total) . 

* Signed 15-bit mantissa and signed 7-bit exponent (24-bit 

total) . 

Since the 8031 chip was used, requiring two ports dedicated 
to memory access, the SDK-51 system was limited to an 8-bit A/D. 
Also, but for different reasons, the PWM was limited to 8 effec- 
tive bits. Since no advantage was seen in going to more bits in 
either case, the extra hardware which would have been required did 
not have to be used. 

Future Development : This report concludes work under the NASA 

grant, so that any future work will be carried out on internal 
funds. However, the development of a slave-master system is of 
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particular interest, because it will make it possible to change 
the gains on individual controllers, as might be required in 
operation. Presently available development systems make this a 
difficult task, because only a single 8051 can be simulated at any 
one time. Specifically, the proposed development would include 
the following: 

* Installing a slave 8031 in the wire-wrap area of the SDK- 
51 . 

* Installing 2K of RAM so that it can be programmed from the 
SDK-51, but can be used to run programs on the slave. 

* Provision for installation of a 2K EPROM in the RAM slot. 

* Provision for programming the EPROM in place. 

* Interconnection of the serial lines on the two 8031’ s. 

* Use of the four high address bits on the slave 8031 to 
control A/D and other board functions. 

This system would be used to develop slave controller 
programs on EPROM which would be used in building separate 
controller boards. The EPROM programming capability would also be 
used to develop additional library programs for the SDK-51. 

CONCLUSIONS AND RECOMMENDATIONS 

* The 8051 series microcontrollers are capable of controlling 
the proof-mass actuator. 

* Eight-bit input and output appears adequate, however, with 
the availabilty of the additional ports on the 8751, A/D’s 
and D/A’s with more bits pose no problem and would require 
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little extra time. 

* Although the floating-point arithemetic gave good results, 
other arithmetic schemes might require less computing time. 
The question requires more investigation than was given in 
the present work. 

* The parallel realization design procedure described in this 
report worked well and appears to be adequate. 

* The recommended design procedure requires a fair amount of 
calculation, especially if the phase margin is to be optimal. 
For best results, it might be advisable to write a computer 
program to determine parameters for the difference equations. 
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APPENDIX A 

EXPERIMENTAL PROGRAM FOR SDK-51 BOARD 

This program was written to assist in the overall development 
of the wire-wrapped controller added to INTEL’S SDK-51 development 
board. It is loaded from a cassette tape, titled ABC9, and 
responds to the keyboard command ’GO FROM O’, by executing a 
program called DEM01 . While executing this or any other program, 
it continuously polls the keyboard, and responds to any inputs 
with ASCII values of 20H to 5FH by a subroutine call to the 
appropriate location in a table. If it encounters RET, it simply 
returns to the current program, but, if it encounters JMP addr . , 
it jumps to a new program. The following is a list of keyboard 
entries which cause jumps to new programs, the number in 
parenthesis is the address of the program: 

C=CDIL (0568H) : The program waits for two hex charac- 
ters in 2’s complement form, which is output to the 
coil. Used to measure coil force output. 

D=DISPLAY (01A8H) : Displays four hex bytes, in 2’s com- 
plement form, indicating readings of the four analog 
input ports. Used for calibration of analog inputs. 

E=ENTER (0454H) : Enters floating-point contents of 
06,07 into first stack location, moves two stack 
contents up, and loses contents of third stack location. 


F=FIX (04E0H) : Fixed-point equivalent of floating-point 
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number in 06,07 is stored in 06 (and displayed) . 

N=NEGATE (0448H) : Floating-point contents of 06,07 are 
negated and replaced in 06,07 (and displayed). 

P=P1-D Program (0300H) : The P-Program, as described in 
the test, is run. 

Q=continue Pl-D Program (0308H) : The P-Program is 
restarted with current parameters (i.e., default values 
are not read) . 

R=READ (0470H) : First floating-point number on stack is 
read into 06,07 (and displayed). Remainder of stack is 
moved down, and third stack location is left unchanged. 

T=T version of Pl-D Program (0330H) : The T-Program, as 
described in the text, is run. 

U=continue T version (0338H) : The T-Program is 
restarted with current parameters (i.e., default values 
are not read) . 

X=EXPONENT (0424H) : The program waits for two hex 
characters, representing the exponent, and enters them 
into 07 (and displays them) . This must follow the 
mantissa entry, which writes over the current exponent. 

Z=N0RMALIZE (043CH) : The floating-point contents of 
06,07 are normalized and replaced in 06,07 (and 
displayed) . 


Space Bar, Shift 0,1 (04D0H0 : 


Parameters are entered 
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from floating point numbers in 06,07, to be followed by 
U to restart T-Program, according to following table: 

Space Bar n 

Shift 1 c 

Shift 2 

Shift 2 to Shift 9 (04D0H) : Parameters are entered from 

floating- point numbers in 06,07, to be followed by Q to 
restart P-Program, according to the following table: 
Shift 3 I 

n 

Shift 4 T 

Shift 5 

Shift 6 top 

Shift 7 G a 

Shift 8 G p 

Shift 9 Gy 

’ * ’ = MULTIPLY (0490H) : Floating -point contents of first 

stack position are multiplied by contents of 06,07, and 
replaced in 06,07 (and displayed). Stack contents are 
moved down, so that both multiplier and multiplicand are 
lost . 


’ + ’ =ADD (04A0H) : Floating-point contents of 06,07 are 
added to contents of first stack position, and replaced 
in 06,07 (and displayed). Stack contents are moved 
down, so that both addends are lost. 

[ - ’ = SUBTRACT (04B0H) : Floating-point contents of 06,07 


are subtracted from contents of first stack position, 
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and replaced in 06,07 (and displayed)- Stack contents 
are moved down, so that subtactor and subtrahend are 
lost . 

* . ’^MANTISSA (0418H) : The program waits for two hex 
characters, and enters them in both 06 and 07. The 
contents of 06 will represent the mantissa, but the 
exponent should follow to be placed in 07. 

0 to 3 (0186H) : DEMOO to DEM03 are run, according to 
the following table: 


0 DEM00 places Channel #0 input at output. 

1 DEM01 places Channel #1 input at output. 

2 DEM02 places Channel #2 input at output. 

3 DEM03 places Channel #3 input at output. 


From the point-of-view of proof-mass controller development, 
the most important items are the two versions of the PI— D control- 
ler, referred to as as the P— and T— Programs. These use 
floating-point subroutines, and make use of the timer interrupt 
feature of the 8031. A key to internal data memory and a listing 
of program ABC9 follows. 


Key to Internal Data Memory- 


Address 

00,01 

02 

03 

04 

05 

06,07 

20 

22 

23 

24 

25 

26 
27 

2A,2B 
2C , 2D 
2E,2F 
30,31 
32,33 
34,35 
36 

38,39 
3A,3B 
3C , 3D 
3E,3F 


Function 

R0 and R1 pointers 

R2 is used for display 

R3 cycle counter 

R4 exponent 

R5 shift counter 

R6, R7 floating point results 

Bit 00 = sign 

Bit 01 = flag 

Channel counter 

Display counter 

Key input 

n = # cycles 

Present output, 2’s complement hex 
Output during next calculation cycle 
n (default value) 
c (default value) 
to^ (default value) 

Calculator stack #1 
Calculator stack #2 
Calculator stack #3 
I (default value) 

T (default value) 

(default value) 
top (default value) 

(default value) 
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40,41 

Gp (default 

value) 

42,43 

Gy (default 

value) 

44,45 

"a t 


46,47 

w p T 


48,49 

g a t 


4A,4B 

G p T 


50,51 

~ X P 


52,53 

X A 


54,55 

-X L 


56,57 

X S 


58,59 

u v 


5A,5B 

U P 


5C,5D 

U A 




APPENDIX A PROGRAM ABC9 
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0000=A JMP 0180 

RESET - Jump to DEMO 9 

0002=N0P 


0003=LJMP E003 

INTERRUPT 1 - Required for SDK-51 

0006=NOP 


0007=N0P 

f * 

0008=N0P 

* 

0009=N0P 


OOOA=NOP 

TIMER 0 INTERRUPT 

OOOB=CLR 8E 

Turn TIMER 1 off 

OOOD=CPL B5 

Invert R.H. Voltage on Coil 

OOOF=CLR 01 

Clear Flag 

001 1=ACAL 0027 

Call Subroutine 

0013=RETI 

Return from Interrupt , . 

0014-N0P 

• 

0015=N0P 


0016=N0P 


0017=NOP 


0018=N0P 


0019=N0P 


001A=N0P 

TIMER 1 INTERRUPT 

001B-CLR 8E 

Turn Timer 1 off 

001D=CPL B5 

Invert R.H. Voltage on coil 

001F=RETI 

Return from Interrupt 

0020=NOP 


0021=N0P 


0O22=N0P 


0023=N0P 


0024=N0P 


0025=N0P 


0026=RETI 

TIMER 0 SUBROUTINE 

0027=PUSH DO 

Save PSW 

0029=PUSH EO 

Save A 

002B=H0V Af 26 

Output to A 

002D=SETB C 

Set Carry 

002E=RLC A 

Rotate output left 

002F=JC 0032 

Skip next instruction if negative 

0031=CPL A 

Complement output 

0032=M0V 8C r A 

Set TIMER 1 

0034=M00 B5rC 

RH Voltage high if output negative 

0036=CPL C 

Invert sign 

0037=M00 B4rC 

L.H. voltage low if output negative 

0039=SETB 8E 

Start TIMER 1 

003B=D JNZ R3 »0047 

Skip 5 instructions if R3 not zero 

003D=M0V R3 r 25 

Reset 

003F=M0V A » 27 

Update 

0041=M00 26 r A 

output 

0043=SETB 01 

Set f i ag 

0045=SETB BO 

Set Osci 1 loscope Signal 

0047=P0P EO 

Retrieve A 

0049=P0P DO 

Retrieve RSW 

004B=RET 

Return 


SUBROUT I NE to READ A/D 
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0054=1400 C*10 

Low digit 

0056=M0V 90 *C 

to p l n 1.0 

0058=M0V Crll 

Next digit 

005A=M00 91 *C 

to p i n 1 . 1 

005C=SETB 93 

Enable A/D 

005E=CLR 92 

Trigger 

0060=SETB 92 

A/D 

0062=N0P 

Wait 

0063=N0P 

Wait 

0064=M0V 90r *FF 

Set Port 3 to read 

0047 S =CLR B3 

Set Transceiver to read 

0069=H0V A»90 

Read A/D i nto A 

006B=CLR 93 

Disable A/D 

006D=SETB B3 

Set transceiver to write 

006F=M0V R4 r *00 

Set exponent to zero ' : 

0071=RET 

Return 


SUBROUTINE FOR INITIAL SETUP . 

007B=M0V 88 r *00 

Set TCON = 0 

007E=M0V 89**23 

Set TMOD. TIMER 0 = Mode 3, TIMER 1 

0081=M0V 97**00 

Set PCON = 0 

0084=M0V 98**00 

Set SCON = 0 

0087=M0V A8 * *EB 

Set IE. Enable both timer interrupt: 

008A=M0V B8**08 

Set IP. Timer 1 has priority 

008D=RET 

Return 

SUBROUTINE TO POLL KEYBOARD 

0094=CLR C 

Clear carry 

0095=LCAL EOOC 

Look for keyboard entry 

0098= JNC OOA3 

Jump to return on no entry 

009A=LCAL E009 

.Read ASC II input 

009D= ANL A**7F 

Set bit #7 to zero 

009F=M0V 24* A 

Save key input 

00A1=ACAL OOAD 

'CALL INTERPRET 

00A3=RET 

Return 


00AD=ANL A * *70 
OOAF=C JNE A**20*OOB4 
OOB2=SJMF’ 00C1 
00B4=CJNE A * *30 * 00B9 
OOB7=S JMP 00C1 
00B9=CJNE A**40*00BE 
OOBC=S JMF’ 00C1 
OOBE=CJNE A**50*00CC 
OOC1=MOV A *24 
00C3=NDP 
00C4=ANL A**3F 
00C6=RL A 

00C7=M0V_DF‘TR * *0100 
bocA=ACAL bocri 
OOCC=RET 
OOCD=CLR 8C 
OOCF=CLR B4 
00D1=CLR B5 
00D3=JMP 0A+DPTR 


SUBROUTINE TO INTERPRET KEYSTROKES 

Remove 4 low bits 

Test for 20H to 2FH 

Jump if successful 

Test for 30H to 3FH 

Jump if successful 

Test for 40H to 4FH 

Jump if successful 

Test for 50H to 5FH 

Get original entry 

NOP 

Skip two high bits 
Mu Iti p |y by 2 

Set DATA POINTER to start of table 

Make it a subroutine call 

Return from subroutine 

Stop TIMER 0 

L.H. voltage to zero 

R.H. voltage to zero 

Jump to table 


Mode 2 


OODA=LCAL EOOF 
OOBD=MOV R2 r #2E 
OOBF=LCAL E006 
00E2=M00 R2 f 06 
OOE4=LCAL E015 
OOE7=MOO R2 1 *58 
00E9=LCAL E006 
OOEC=MOO R2f 07 
OOEE=LCAL E015 
OOF1=MOO R2>*20 
OOF3=LCAL E006 
OOF6=MOV R2r 24 
OOF8=LCAL E006 
OOFB=ACAL 0094 
OOFD=SJMP OOFB 


SUBROUT r NE • TO D I SPLAY & WA I T 

Clear display 

Output 

period 

Output 

mantissa 

Output 

Cap. X 
Output 

exponent 

Output 

space 

Output 

keystroke 
Look for new 
keystroke 
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0100=RET 

0101=RET 

0102=RET 

0103=RET 

0104=RET. 

0105=RET 

0106=AJMP 0568 

0108=AJMP 01A8 

010A=A JMP 0454 

010C=AJMP 04E0 

010E=RET 

010F =RET 

0110=RET 

0111=RET 

01 12=RET 

01 13=RET 

0114=RET 

01 15=RET 

01 16=RET 

0117=RET 

01 18=RET 

01 19=RET 

011A=RET 

01 1B=RET 

01 1C=A JMP 0448 

01 1E=RET 

01 1F=RET 

0120=AJMP 0300 

0122=A JMP 0308 

0124=AJMP 0470 

0126=RET 

0127=RET 

01 28= A JMP 0330 

012A=AJMP 0338 

012C=RET 

012D=RET 

012E=RET 

012F=RET 


TABLE = KEYSTROKES 40H to 57H 


C = Coi I . Force ' 

D = Display four analog inputs 
E = Enter onto stack 
F - Fixed Decimal 


N = Negate 


P = Pl-D Program 
Q h Continue P 
R = Read stack 


T - Alternate Pl-D Program 
U = Continue T 



TABLE: KEYSTROKES 58H to 5FH; 20H to 3FH 


0130=AJMP 

0132=RET 

0133=RET 

0424 

X = Exponent 

0134=AJMP 

0136=RET 

043C 

Z = Norma 1 i ze 

0137=RET 

0133=RET 

0139=RET 

013A=RET 

013B=RET 

013C=RET 



013D=RET 

013E=RET 



013F=RET 


* ; 

0140=NDP 

0141=N0P 



0142=N0P 

0143=N0P 



0144=AJMP 

0146=N0P 

0147=N0P 

014S=N0P 

04C0 

Shift 0 to 2 

0149=N0P 

014A=N0P 

014B=N0P 



014C=N0P 

014D=N0P 

014E=N0P 

014F=N0P 

0150=NOP 

0151=N0P 



0152=AJMP 

04D0 

Shift 3 to 9 

0154=AJMP 

0490 

'*’= Multiply 

0156=A JMP 

015S=RET 

0159=RET 

04A0 

*+' = Add 

015A=A JMP 

04B0 

= Subtract 

015C=A JMP 

015E=RET 

015F=RET 

0418 

' . ' = Mant i sser 

0160=AJHP 

0186 

DEMO i . Proxi meter test 

0162=A JHP 

0186 

DEMO 2 . Acce lerometer test 

0164-AJMP 

0186 

DEMO 3 . LVDT test 

0166=A JMP 
0168=RET 

+ 

017F=RET 

0186 

DEMO 4 . Signal generator test 



DEMO 0-3 PROGRAMS 


0180=LCAL EOOC 
01S3=M0V 24»*30 
0186=M0V 81j-* 60 
01S9=M0V 25**01 
018C=ACAL 007B 
018E=SETB 8C 
0190=CLR 01 
0192=M0V A * 24 
0194=MOV 22 r A 
0196=ACAL 0054 
01 98= MOV 27* A 
019A=CLR BO 
019C=ACAL 0094 
019E=JB 01 *0190 
01A1=SJMP 019E 


Read keyboard 
Set input channel to #0 
Stack pointer = 60 
Counter input = 0 
CALL INITIAL SETUP 
Start TIMER 0 
Clear flag 
Keystroke (0 to 3) 
into Channel # 

Ca I I READ A/D 

A/D Input to 27 

Clear oscilloscope signal 

CALL POLL KEYBOARD 

Jump if flag high 

Wait for interrupt 


01 A8=MQV 81**60 
01AB=N0P 
01 AC=NOP 
01 AD=NQP 
01AE=ACAL 0078 
01BO=MOV A8**E1 
01B3=M0V B8**00 
01B6=SETB 8C 
01B8=ACAL 01C0 
01BA=ACAL 0094 
01BC=SJMP 01B8 


DISPLAY 4 INPUTS 
Stack pointer = 60 


CALL INITIAL SETUP 

Reset IE - Disable interrupts 

Reset IP - Cancel interrupt priorities 

Start TIMER 0 

CALL INPUT subroutine 

CALL POLL KEYBOARD 

Continue 


01C0= JNB 8Dr01El 
01C3=CLR 8D 
01C5=INC 23 
01C7=M0V Af 23 
01C9=JNZ 01E1 
01CB=LCAL EOOF 
01CE=M0V RO y *22 
01D0=M0V @R0»*00 
01B2=ACAL 0054 
01D4=M0V R2» A 
01D5=LCAL E015 
01D8=M0V R2 r *2C 
01DA=LCAL E006 
01DD=INC 0RO 
01DE=CJNE @R0f*04,01D2 
01E1=RET 


SUBROUTINE FOR INPUT 
Return if TIMER 0 flag low 
Clear TIMER 0 overflow flag 
Increment display counter 
Return on 

nonzero display counter 
Clear display 
Set channel #0 
to zero 
CALL READ A/D 
Display 
read i ng 
Output 
comma 

Increment channel § 

Continue if channel # not 5 
Return 
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01F0= JNB D2 » 01F7 
01F3=RRC A 

01F4=CJNE R4,*7F,01F8 
01F7=RET 
01F8=INC R4 
01F9=RET 


SUBROUTINE TO CORRECT MANTISSA OVERFLOW 
Return on no OVERFLOW 
Rotate right 

Jump if exponent not maximum 
Return 

Increment exponent 
Return 


0204=CPL A 
0205=ADD Af *01 
0207=ACAL 01F0 
0209=RET 


SUBROUTINE TO NEGATE A, 04 

Complement A 

Add Unity 

Correct overflow 

Retu rn , 


0210= JB E7r 0219 
0213= JB E6 r 0221 
0216=SETB C 
0217=S JMP 021 D 
0219= JNB E6 1 0221 
021C=CLR C 
021D=RLC A 

021E=CJNE R4 r *80 1 0222 
0221=RET 
0222=DEC R4 
0223=SJMP 0210 


SUBROUTINE TO NORMALIZE MANTISSA 
Jump if negative 
Return if normalized 
Set carry if positive 
to enter T’s 
Return if normalized 
Clear carry if negative to enter O’s 
Rotate left through carry 
Jump if exponent not minimum 
Return . 

Decrement exponent 
Conti nue 


0228=INC R5 
0229=D JNZ R5 r 022C 
022B=RET 
022C=H00 CrE7 
022E=RRC A 
022F=SJMP 0229 


SUBROUTINE TO SHIFT MANTISSA TO RIGHT 
Increment shift counter 

Decrement shift counter, jump if nonzero 
Return 

Set carry = sign bit 
Rotate, right 
Continue 


0234=N0V R6r A 
0235=M0V R7>04 
0237=RET 


SUBROUTINE MOVE "A,- 04 'TO 06, 07 
A to 06 
04 to 07 
Return 


0240=- INC RO 
0241 “INC R1 
0242-M00 Ai-GRO 
0243=CLR C 
0244=SUBB A r (?R1 
0245=CPL C 
0246= JNB D2 ? 024 A 
0249=RRC A 
024A=JB E7 y 0258 
024D=M00 R5 r A 
024E=M00 04 r @R0 
0250=DEC R1 
0251=M0V A * @R1 
0252=ACAL 0228 
0254=DEC RO 
0255=ADD A 1 - 8 RO 
0256=SJMP 0263 
0253=CPL A 
0259=INC A 
025A=M0V R5r A 
025B=M0V 04 r (?R1 
025B=DEC RO 
025E=M00 AfGRO 
025F=ACAL 0228 
0261=DEC R1 
0262=ADD ArG?Rl 
0263=ACAL 01F0 
0265=ACAL 0210 
0267=ACAL 0234 
0269=RET 


SUBROUTINE @R0 + @R1 ->- 06.07 
Increment RO to exponent address 
Increment Rl to exponent address 
Exponent = #0 
Clear carry 
^ Subtract exponent #0 
Complement carry 

Skip next instruction if.no overflow 
Rotate right 

Skip eight instructions if negative 

Set exponent difference in shift counter 

Store exponent #0 in 04 

Decrement Rl to Mantissa address 

Mantissa #1 to A 

CALL SHIFT MANTISSA 

Decrement RO to Mantissa address 

Add Mantissa # 0 

Jump to exit 

Complement to get exponent difference 
Add I to get 2's complement 
Set exponent difference in shift counter 
■Store exponent #1 in 04 
Decrement RO to Mantissa address 
; Mantissa #0 to A 
CALL SHIFT MANTISSA 
Decrement Rl to Mantissa address 
Add Mantissa #\ 

(Exit) • CALL CORRECT MANTISSA 
CALL NORMALIZE MANTISSA 
CALL MOVE A, 04 to 06, 07 
:Return 


026C=M00 A,8R1 
026D=INC Rl 
026E=MQV 04 1 G?R 1 
0270=DEC Rl 
0271=ACAL 0204 
0273=ACAL 0210 
0275=M0V @R1 t A 
0276=INC Rl 
0277=M0V (?R1 1 04 
0279=DEC Rl 
027A=RET 


SUBROUTINE NEGATE g Rl 
Mantissa #1 to A 
Increment Rl to exponent address 
.Exponent #\ to 04 
Decrement Rl to Mantissa address 
CALL NEGATE A, 04 
CALL NORMALIZE MANTISSA 
; Store Mantissa 

; Increment Rl to exponent address 
Store exponent 
Restore Rl 
Return 


027C=ACAL 
027E=ACAL 
02B0=C JNE 
0283=SJMP 
0285=ACAL 
0287=RET 


026C 

0240 

Rl » 06 > 0285 

0287 

026C 


SUBROUTINE § RO - 8Rj ± 06, 07 

CALL NEGATE § Rl 

CALL § RO +.6R1 ^06, 07 

Skip next instruction if RO not 06 

Jump to return 

CALL NEGATE @ Rl 

Return 


02D0=CLR A 
02D1=M0V 04 r A 
02D3=M0V A t SRO 
02D4=ACAL 0210 
02D6=M0V SRI » A 
02D7=XNC R1 
02D8=M0V GR1 *04 
02DA=DEC R1 
02DB=RET 


SUBROUTINE FLOAT @R0 to 6R1 
Clear A 
Zero to 04 
Mantissa # 0 to A 

CALL NORMALIZE MANTISSA (ENTRY)* 

A to Mantissa #1 

Increment R1 to exponent 

04 to exponent #1 

Restore R1 , . 

Return- 

*ENTRY FOR FLOAT A, 04 to §R1 


02DC=INC RO 
02DD=M00 A* SRO 
02BE=DEC RO 
02DF=JB E7»02EB 
02E2=JZ 02ED 
02E4=M00 A»SR0 
02E5=ANL A*#80 
02E7=ACAL 0210 
02E9=SJMP 02F1 
02EB=CF’L A 
02EOINC A 
02ED=M0V R5r A 
02EE=M00 AtSRO 
02EF=ACAL 0228 
02F1=MDV SRI f A 
02F2=RET 


SUBROUTINE FIX @R0 to @R1 
Increment RO to exponent 
Exponent #0 to A 
Decrement RO to Mantissa 
Skip 5 instructions if negative 
Skip 6 instructions if zero 
Mantissa #0 to A 
Keep sign of Mantissa 
CALL NORMALIZE MANTISSA 
Jump to exit 

Complement negative exponent 
2's complement 
Set shift counter 
Mantissa # 0 to A 
CALL SHIFT MANTISSA 
(Exit) A to Mantissa #1 
Return 


02F4=M00 SRI r 06 
02F6=INC R1 
02F7=M0V SRI r07 
02F9=DEC R1 
02FA=RET 


SUBROUTINE' STORE '06, 07 in @R1 

06 to Mantissa #1 
Increment R1 to exponent 

07 to exponent #1 
Restore R1 
Return 


0300=M0V 81f*60 
0303=M0V DPTRf*04FO 
0306=ACAL J>356_ 
0308=‘ACAL' 0362 
030A=ACAL 0380 
030C=ACAL 03A0 
030E=ACAL 03D8 
0310=M0V ROf *56 
0312=M0V R1 f *5A 
0314=ACAL 0240 
0316=M00 ROr *06 
0318=M0V Rif *5C 
031 A=ACAL 0240 
O31C=MO0 RO r *06 
031E=M0V Rlr *27 
0320=ACAL 02DC 
0322=CLR BO 
0324=ACAL 0094 
0326=JB 01 f 030A 
0329=SJMP 0326 


O330=M0V 81 f *60 
O333=M0V DPTRf*05F8 
0336=ACAL 0340 
0338=ACAL 0500 
033A=AJMP 0308 


0340=ACAL 007B 
0342=M0Y Rif *2 A 
0344=H0VX AfGDPT 
0345=M0V GRlfA 
0346=INC DPTR 
0347- INC R1 
0348=CJNE R1 f *30 f 0344 
034B=RET 


0356=ACAL 007B 
0358=M00 Rif *36 
035A=M0VX AfGDPT 
O35B=M0V GRlfA 
035C=INC DPTR 
035D=INC R1 
035E=CJNE Rlf*44f035A 
0361=RET 


P-PROGRAM 

Set stack pointer to 60 

Set data pointer to TABLE 1 

CALL READ P PARAMETERS 

CALL MULTIPLY. BY T 

CALL READ INPUTS 

CALL CALCULATE Up 

CALL CALCULATE U a 

SET RO to Xs 

SET R1 to Up 

CALL @R0 + @R1 to 06, 07 
SET RO to 06 

SET R1 to Ua . 

CALL @ RO + @R1 to 06, 6l 
SET RO to 06 
SET R1 to OUTPUT 
CALL FiX @R0 to ®R1 
CLEAR oscilloscope signal 
CALL POLL KEYBOARD 
LOOP if flag high 
Wait for interrupt 


T- PROGRAM 

Set stack pointer to 60 
Set data pointer to TABLE 2 
CALL READ T PARAMETERS 
CALL CALCULATE PARAMETERS 
Jump to P-Program 

SUBROUTINE READ T PARAMETERS 

CALL INITIAL SETUP 

Set R1 to n 

TABLE 2 to A 

Store A 

Increment data pointer 
Increment R1 
LOOP until R1 = 30 
Return 


SUBROUTINE READ P PARAMETERS 

CALL INITIAL SETUP 

Set R1 to In 

TABLE 1 to A 

Store' A 

Increment data pointer 
Increment R1 
LOOP until R1 = 44 
Return 


0288=M0V A»GRO 
0289=M0V GRlrA 
028A=INC RO 
028B=INC R1 
028C=M0V ArGRO 
028D=M0V GRlrA 
023E=DEC RO 
028F=DEC R1 
0290=RET 


0294=CLR 00 

0?96=INC RO 

0297=INC R1 

0298=M0V A»GRO 

0299=ADD A»GR1 

029A=JNB *D2»02AS 

029B=JNC 02A3 

029F=M0V Ar*80 

02A1=S JMP 02A5 

02A3=M0V A r ♦7F 

02A5=M0V R4r A 

02A6=DEC RO 

02A7=DEC R1 

02A8=M0V A>GRO 

02A9=JNB E7r02B0 

02AC=CPL 00 

02AE=ACAL 0204 

02B0=N0P 

02B1=MOV FO » A 

02B3=H00 A»GR1 

02B4=JNB E7f 02BB 

02B7=CPL 00 

02B9=ACAL 0204 

02BB=CLR C 

02BC=RLC A 

02BD=MUL AB 

02BE=M0V ArFO 

<02CO=NOP 

02C1=N0P 

02C2=N0P 

02C3=NOP 

02C4=N0P 

02C5=N0P • 

02C6= JNB 00 i 02CB 

02C9=ACAL 0204 

02CB=ACAL 0210 

02CD=ACAL 0234 

02CF=RET 

* 
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SUBROUTINE SHIFT @ RO ->- @R1 
Mantissa #0 to A 
A to Mantissa #1 

Increment RO to exponent address 

Increment R1 to exponent address 

Exponent #0 to A 

A to exponent #1 

Restore RO 

Restore R1 

Return 


SUBROUTINE @R0 * @R1 +06, 07 
Clear sign flag > - 

Increment RO to exponent address 
Increment R1 to exponent address 
Exponent #0 to A 
Add exponent #1 

Skip 4 instructions if. no overflow 

Skip 2 instructions if positive 

Set exponent to 80H 

Skip next instruction 

Set exponent to 7FH 

Exponent to 04. 

Decrement RO to Mantissa address 
Decrement R1 to Mantissa address 
Mantissa #0 to A 

Skip two instructions if positive- 
Complement sign bit 
CALL NEGATE A, 04 
NOP 

Mantissa #0 to B 
Mantissa #\ to A 

Skip two instructions if positive 
Complement sign bit 
CALL NEGATE A, 04 
Clear carry 
Rotate left 
Multiphy A * B 
Product to A 
NOP's 
to 
be 

removed 


Skip two instructions if sign positive 

NEGATE A, 04 

CALL NORMALIZE MANTISSA 

CALL MOVE A, 04 to 06, 07 

Return 


0362=M0V R0f*3A 
0364=M0V R1 » *44 
0366=F , USH 01 
0368=M0U Rif *38 
036A-ACAL 0294 
036C=F'QP 01 
036E=ACAL 02F4 
0370=INC R0 
0371=INC RO 
0372=INC Rl' 

0373=INC Rl 
0374=CJNE Rl t #4C » 0366 
0377=M0V A f 36 
0379=MOV 25 f A 
037B=SETB 8C 
037D=RET 


0380=CL.R 01 
0382=M0V 22r*00 
0385=M0V Rl r *50 
0387=ACAL 0054 
0339=ACAL 02D4 
038B=INC 22 
038D=INC Rl 
038E=INC Rl 
038F=C JNE Rl r *58 r 0387 
0392=M0V R0f*50 
0394=M0V Rif *54 
0396=ACAL 0240 
0398=ACAL 02F4 • 
039A=RET 


03A0=M0V RO i *46 
03A2=M0V Rl r *5A 
03A4=ACAL 0294 
03A6=M0V R0ft06 
03A8=M0V Rl ? *58 
03AA=ACAL 027C 
03AC=ACAL 02F4 
03AE=M0V R0r*4A 
03B0=M0V Rif *54 
03B2=ACAL 0294 
03B4=M0V Rif *58 
03B6=M00 RO r *06 
03B8=ACAL 027C 
03BA=ACAL 02F4 
03BC=M0V RO f *42 
03BE=H0V Rlr *54 
03C0=ACAL 0294 
03C2=M00 RO f *58 
03C4=M00 Rif *06 
03C6=ACAL 0240 
03C8=M0V Rif *5 A 
03CA=ACAL 02F4 
03CC=RET 


SUBROUTINE MULTIPLY BY T 

Set RO to wa 

Set Rl to mat 

Save Rl 

Set Rl to T 

CALL @R0 * @R1 to 06, 07 
Retrieve Rl 

CALL STORE 06, 07 in 6R1 
Increment RO 
twice 

Increment Rl 
twice 

Loop unti I Rl = 4C 
STORE In 
in 25 

Start TIMER 0 

Retu rn * 

SUBROUTINE READ INPUTS 
Clear flag 
Set channel # to 0 
Set Rl to - Xp 
CALL READ A/D 
CALL FLOAT A, 04 to SRI 
Increment channel # 
Increment Rl 
twice 

Loop unti I Rl = 58 

Set RO to - Xp 

Set Rl to -XI 

CALL @R0 + SRI to 06, 07 

CALL STORE 06, 07 in S Rl 

Return 

SUBROUTINE CALCULATE Up 

Set RO to wpt 

Set Rl to Up 

upTup to 06, 07 

Set RO to 06, 07 

Set Rl' to Uv 

upTup - Uv to 06, 07 

wpTup - Uv to Uv 

RO set to Gpt 

Rl set to Xp 

-XpGpT to 06, 07 

Set Rl to Uv 

Set RO to 06, 07 

Updated Uv to 06, 07 

Updated Uv to Uv 

Set RO to Gv 

Set Rl to -Xp 

-XpGv to 06, 07 

Set RO to Uv 

Set Rl to 06 

Uv - XpGv to 06, 07 

Set Rl to Up 

Uv - XpGv to Up 

Return 


03D3=M0Y R0t*44 
03DA=M0U R1»*5C 
03DC=ACAL 0294 
03DE=MOV R0f*06 
03EO--MOV R1f*5C 
03E2=ACAL 027C 
03E4=ACAL 02F4 
03E6=M0V R0 f * 48 
03E8=M0V R'l f *52 
03EA=ACAL 0294 
03EC=M0Y R1f*5C 
03EE=M0V R0f*06 
03F0=ACAL 027C 
03F2=ACAL 02F4 
03F4=RET 


SUBROUTINE CALCULATE Ua 
Set RO to waT 
Set R1 to Ua 
waTUa to 06, 07 
Set RO to 06 
Set R1 to Ua ' 
waTUa - Ua to 06, 07 
waTUa - Ua to V a 
Set RO to GaT 
Set R1 to Xa 
GaTXa to 06, 07 
Set R1 to Ua 
Set R0 to 06, 07 
Updated Ua to 06,07 
Updated Ua to Ua 
Return 


0400=LCAL E009 
0403=M0V R2fA 
0404=LCAL EO}B 
0407=SWAP A 
0408=MOV R7f A 
0409=LCAL E009 
040C=M0U R2» A 
040D=LCAL EOIB 
04 10= ADD A»R7 
0411=M0V R7 f A 
0412=RET 


SUBROUTINE READ HEX BYTE 

CALL READ KEY 

Store i n R2 

CALL CONVERT TO HEX 

Place in top 4 bits 

Sto re in R7 

CALL READ KEY 

Store in R2 

CALL CONVERT TO HEX 

Add to R7 

Store i n R7 

Return 


0418=M0V 81 f #60 
041B=ACAL 0400 
041D=M0V R6f07 
041F=AJMP OODA 


0424=H0V 81 f *60 
0427=ACAL 0400 
0429=AJMP OODA 


PROGRAM TO READ MANTISSA 
Set stack pointer to 60 
CALL READ HEX BYTE 
Store i n 06 

Jump to DISPLAY AND WAIT 

PROGRAM , X' To READ EXPONENT 
Set stack pointer to 60 
CALL READ HEX TYTE 
Jump to DISPLAY AND WAIT 


0430=M0V AfR6 
0431=M0V 04 f R7 
0433=ACAL 0210 
0435=M0V R6fA 
0436=M0V R7f04 
0438=RET 


SUBROUTINE TO NORMALIZE 

06 to A 

07 to 04 

CALL TO NORMALIZE A, 04 
A to 06 
04 to 07 
Return 


043C=M0V 81 f #60 
043F=ACAL 0430 
0441=A JMP OODA 


PROGRAM > Z t NORMALIZE DISPLAY 
Set stack pointer to 60 
CALL NORMALIZE 
Jump to DISPLAY AND WAIT 
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0448=M0V 81 r *60 
044B=M0V Rif *06 
044D=ACAL 026C 
044F=AJMP 00DA 


0454=M0V 81 f *60 
0457=M0V Rif *35 
0459=M0V R0r*33 
045B=M0V Af GRO 
045C=M0V GRlfA 
045D=DEC RO 
045E=DEC R1 
045F=CJNE RO t *2F r 045B 
0462=M0V GR1 r 07 
0464=D£C R1 
0465=M0V GR1 i 06 
0467=AJMP OODA 


0470=M00 81 r *60 
0473=M0V R0f*30 
0475=M0V R1 ? *06 
0477=ACAL 0288 
0479=ACAL 0480 
047B=AJMP OODA 


0480=M0V R0r*32 
0482=M0V R1 » *30 
0484=H0V A»@R0 
0485=M0V @R1 r A 
0486=INC RO 
0487=INC R1 
0488=C JNE RO » *36 t 0484 
048B=RET 


0490=M00 81rt60 
0493=M0V R0f#30 
0495=H0V Rif *06 
0497=ACAL 0294 
0499=ACAL 0480 
049B=AJMP OODA 


PROGRAM , N t to NEGATE DISPLAY 
,Set stack pointer to 60 . 

Set R1 to 06 

CALL NEGATE §R1 

Jump to DISPLAY and WAIT 


PROGRAM ' E 1 to ENTER STACK 

Set stack pointer to 60 

Set R1. to STACK 3 ' : 

•Set R2 to STACK 2 

Old stack to A 

A to new stack 

Decrement RO 

Decrement R1 

Loop until RO = 2FH 

07 to stack. 1 exponent 

Decrement R1 

06 to Stack 1 Mantissa 

Jume to DISPLAY and WAIT 


PROGRAM T R T to READ STACK 

Set stack pointer to 60 

Set RO to STACK 1 

Set Rl to 06 

CALL @R0 to 0R1 

CALL SHIFT STACK 

Jump to DISPLAY and WAIT 


SUBROUTINE TO SHIFT STACK 

Set RO to -5TACK 2 

Set Rl to STACK 1 

Old stack to A 

A to new stack 

Increment RO 

Increment Rl 

Loop unti I RO = 36 

Return 


PROGRAM to MULTIPLY 
Set stack pointer to 60 
Set RO to STACK 1 
Set Rl to OG 

CALL @R0 * @R1 to 06, 07 

CALL SHIFT STACK 

Jump to DISPLAY and WAIT 


04A0-MQ0 81»*60 
04A3=M0V RO t *30 
04A5=M00 Rl»*06 
04A7=ACAL 0240 
04A9=ACAL 0480 
04AB=AJMP OODA 


PROGRAM ' + ' to ADD 
Set stack pointer to 60 . 
Set RO to STACK 1 
Set R1 to 06 

CALL @R0 + @R1 to 06, 07 

CALL SHIFT STACK 

Jump to DISPLAY and WAIT 


04B0=M0V 8i»*60 
04B3=M0V R0f#30 
04B5=M0V Rl»*06 
04B7=ACAL 027C 
04B9=ACAL 0480 
04BB=AJMP OODA 


PROGRAM l - t to SUBTRACT ' : 

Set stack pointer to 60 
Set RO to STACK 1 
Set R1 to 06 

CALL @R0 - @R1 to 06, 07 

CALL SHIFT STACK 

Jump to DISPLAY and WAIT 


04C0=M0V 81 >>*60 
04C3=M00 A r 24 
04C5=CLR C 
04C6=RLC A 
04C7=ADD A»*EA 
04C9=M0V R1 » A 
04CA=ACAL 02F4 
04CC=AJHP OODA 


PROGRAM S.B.. SHIFTS 1,1. INPUTS 

Set stack pointer to 60 

Key input to A 

Clear carry 

Rotate A left 

Subtract 6 

Resu I t to R1 

CALL 06, 07 to @R1 

Jump to DISPLAY and WAIT 


04D0=M0V 81 f *60 
04D3=M0V A»24 
04D5=CLR C 
04D6=RLC A 
04D7=ADD A » *F0 
04D9=M0V R1 » A 
04DA=ACAL 02F4 
04DC=AJMP OODA 


PROGRAM SHIFTS 1-9. INPUTS 

Set stack pointer to 60 

Key input to A 

Clear carry 

Rotate A left 

Subtract 16 

Result to R1 

CALL 06, 07 to @R1 

Jump to DISPLAY and WAIT 


04E0=M0V 81 r *60 
04E3=M00 RO i #06 
04E5=M0V Rl»*06 
04E7=ACAL 02DC 
04E9=AJMP OODA 


PROGRAM »F f to FIX DISPLAY 

Set stack pointer to 60 

Set RO to 06 

Set R1 to 06 

CALL FIX @R0 to @R1 

Jump to DISPLAY and WAIT 


• . . TABLE 1 . PARAMETERS FOR PROGRAM P 

CBYT 04FO=10fOOf40fF9 In , T 
CBYT 04F4=48f 06f 5Ef 07 coa , cop 
CBYT 04F8=66 f 06 f 5E 1 05 6a , Gp 
CBYT 04FC=40f *03f OOf 00 Gv 


0500=M0V" EiRTRf #05E8 
0503=M0V ROf *06 
0505=ACAL 0558 
0507=M0V R1 f *2A 
0509=ACAL 0294 
O5OB=M0V Rif *36 
050D=ACAL 02DC 
050F=ACAL 0558 
0511=M0V Rlr*2A 
0513=ACAL 0294 
0515=M0V Rif *38 
0517=ACAL 02F4 
0519=ACAL 0558 
051B=M0V Rlf*2C 
051D=ACAL 0294 
051F=M0V Rlf*3A 
0521=ACAL 02F4 
0523=ACAL 0558 
0525=M0V Rl'f *2E 
0527=ACAL 0294 
0529=M0V Rlr*3C 
052B=ACAL 02F4 
052D=ACAL 0558 
052F=M0V Rlf*2C 
0531=ACAL 0294 
0533=M0V Rlf*3E 
0535=ACAL 02F4 
0537=ACAL 0558 
0539=M0V Rlf*2E 
053B=ACAL 0294 
053D=M0V Rlf*2E 
053F=ACAL 0294 
0541=M0V Rif *42 
0543=ACAL 02F4 
0545=ACAL 0558 
0547=ACAL 0294 
0549=M0V Rlf*2E 
054B=ACAL 0294 
054D=M0V Rif *40 
054F=ACAL 02F4 
0551=RET 


SUBROUTINE - CALCULATE T PARAMETERS 

SET data pointer to TABLE 2 

SET RO to 06 

CALL GET DATA 

SET R1 to n 

CALL @R0 + @R1 fo 06, 07 

SET R1 to In 

CALL FIX @R0 to @R1 

CALL GET DATA 

SET R1 to n 

CALL @R0 * @R1 to 06, 07 

SET R1 to T 

CALL 06, 07 to #R1 

CALL GET DATA 

SET R1 to C 

CALL @R0 * §R1 to 06, 07 

SET R1 to wa 

CALL 06, 07 to §R1 

CALL GET DATA 

Set R1 to con 

CALL @R0 * §R1 to 06, 07 

SET R1 to cop 

CALL 06, 07 to §R1 

CALL GET DATA 

Set R1 to C 

CALL @RQ * 6R1 to 06, 07 
SET R1 to Ga 
CALL 06, 07 to §R1 
CALL GET DATA 
Set R1 to con 

CALL @R0 * @R1 to 06, 07 
Set R1 to con 

CALL @R0 * §R1 to 06, 07 

SET R1 to Gv 

CALL 06, 07 to §R1 

CALL GET DATA 

CALL @R0 * §R1 to 06, 07 

Set R1 to con 

CALL @R0 * @R1 to 06, 07 
SET R1 to Gp 
CALL 06, 07 to §R1 
Return 


0558=M0VX ArSDPT 
0559=MOV 06 r A 
055B=INC DPTR 
055C=M0VX A t SDPT 
055D=M0V 07 » A 
055F=INC DPTR 
0560=RET 


SUBROUTINE TO GET DATA • 
Move from TABLE to A 
A to 06 (Mantissa) 
Increment data pointer 
Move from TABLE to A 
A to 07 (exponent) 
Increment data pointer 
Return 


0568=M0V 81 r 4=60 
056B-M0V 25 1 =101 
056E=ACAL 007B 
0570=ACAL 0400 
0572=SETB 8C 
0574=CLR 01 
0576=M0V A»07 
0578=M0V 27 r A 
057A=CLR BO 
057C=ACAL 0094 
057E=JB 01 r 0574 
0581=SJMP 057E 


PROGRAM 'C* FOR COIL FORCE 

SET stack pointer to 60 

SET 1 cycle 

CALL SETUP 

CALL READ HEX BYTE 

Start TIMER 0 

Clear flag 

07 (HEX BYTE) to A 

A to output 

Clear oscilloscope signal 
CALL POLL KEYBOARD 
Loop if flag high 
Wait for interrupt 


CBYT 05E8=40,FA,43rF5 
CBYT 05EC=73 ? 02 r 40 r 04 
CBYT 05F0=51 r 03 r 75f FB 
CBYT 05F4=40r00r00?00 
CBYT 05F8=40 * 05 r 50» 04 
CBYT 05FC=5Er04r00r00 


TABLE 2 FOR T-PROGRAM 

2-7, 256x10-6 

3.60, 8 

5.08, .0287 

.5, — 

n,c 

wn — 
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APPENDIX B 
SCHEMATICS 


Six logic diagrams for the digital controller follow. Each 
has a sheet number, used when referring to connections between 
different sheets. Power and ground connections to standard DIPs 
are not shown, nor are despiking capacitors. The first five 
sheets refer to circuits on the wire-wrap area of the SDK-51 
board, while sheet 6 refers to the PWM board. 

Sheet 1, Figure B1 : This shows the transceiver which was used to 
permit sharing of some pins between input and output functions. 
Also, the drivers for the PWM board are shown. These were needed 
because the signals from the 8031 where inadequate to drive the 
LED’s in the opto-transistors . 

Sheet. 2, Figure B2 : This shows the A/D converter, which is made 
up from a DAC0800 8-bit D/A converter, and a DM2502 successive 
approximation register. A high speed LM361 comparator is used to 
produce a TTL signal to the DM2502, which requires ten cycles to 
convergence. Presently, a 3 MHz clock is being used, so that con- 
vergence time is 3.33 microseconds. It is only achieving about 
7-bit accuracy, but it is hoped that this will be improved with 
further adjustment. 

Sheet 3, Figure B3 : This shows the clock used to drive the A/D 
converter. It is derived from the 12 MHz crystal on the SDK-51 
board, and provides four options, ranging from 6 MHz to 0.75 MHz, 
selectable with a jumper. Also, there is a one-and-one-only cir- 
cuit to synchronize the start of the A/D with the clock. 

Sheet 4, Figure B4 : This shows the analog switch and demul- 
tiplexer circuit used to select the analog channel which is to be 
read by the A/D converter. A high speed operational amplifier is 
necessary to provide adequate output impedance combined with the 
switching speed required. 

Sheet 5, Figure B5 : This shows a typical analog amplifier cir- 
cuit, of which two are presently populated on the wire-wrap area. 
The circuit is provided with three jumpers to provide flexibility 
in selecting gain ranges and input offsets, such as are 
experienced with the proximeter . Diode protection prevents 
accidental damage to the circuits, should the input voltage become 
excessive . 

Sheet 6 , Figure B6 : This shows the pulse-width-modulation (PWM) 
board, which is mounted on the proof-mass actuator. Each end of 
the coil can be switched independently, so that, with suitable 
digital program logic, high currents can be avoided with the 
actuator in a quiescent state. Although there is a 15V supply, 
the circuit only provides an 8V differential, which provides about 
one Ampere of current in either direction. Planned improvements 
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FIGURE B2 

Sheet 2: A/D Converter 
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FIGURE B5 

Sheet 5: Analog Input Port (Typical) 
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Sheet 4 



Connector to device 
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in this circuit should make at least one and a half Amperes pos- 
sible. Opto-transistors permit electrical isolation of this 
board, with its own power supply, from the SDK-51 board. 


